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SECTION  I 
INTRODUCTION 


1 . 1 Background 

The  Global  Positioning  System  (GPS)  is  a satellite 
navigation  system  currently  under  development  by  the 
U.  S.  Department  of  Defense.  The  Air  Force  Avionics 
Laboratory  (AFAL)  is  participating  in  this  program  with 
the  development  of  a Generalized  Development  Model  (GDM) 
of  GPS  User  Equipment.  The  AFAL  GDM  will  serve  as  a 
flight  test  bed  to  evaluate  high  anti-jam  system  tech- 
niques for  military  applications  and  to  expand  the  tech- 
nology base  for  GPS  User  Equipment. 

In  support  of  the  AFAL  GPS  development  responsibi- 
lities, personnel  at  the  AFAL  have  developed  a simulation 
program  for  evaluating  the  performance  of  integrated 
GPS/inertial  navigation  systems.  This  simulator,  called 
the  IGI  (Integrated  GPS/Inertial)  Simulator,  provides  a 
direct  time  domain  simulation  of  the  errors  in  an  inertial 
navigation  system  and  the  errors  in  GPS  measurements.  It 
provides  the  framework  for  evaluating  alternate  sequential 
filter  designs  for  mixing  the  GPS  and  inertial  data  to 
provide  the  desired  accurate  navigation  outputs.  A paper 
by  K.  A.  Myers  and  R.  R.  Butler  of  the  AFAL  provides  an 
introduction  to  the  IGI  Simulator t ^ 1 . An  overview  of  the 
simulator  design  is  provided  plus  some  simulation  results 
for  a six-hour  flight  of  a C5A. 

The  AFAL  has  contracted  with  Intermetrics  to  provide 
additional  analysis,  simulation,  and  software  support.  One 
of  the  tasks  undertaken  by  Intermetrics  includes  vertical 
channel  analysis  and  simulation  using  the  IGI  simulator. 
This  report  summarizes  the  results  of  this  analysis. 

1 . 2 V'?rtical  Channel  Design  Issues 

The  vertical  channel  of  a pure  inertial  navigator  is 
known  to  be  unstable.  Assuming  gravity  is  computed  as  a 
function  of  the  indicated  altitude,  it  can  be  shown  that 
the  positive  feedback  caused  by  the  gravity  computation 
error  produces  exponential  growth  in  the  errors  in  the 
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indicated  vertical  velocity  and  altitude.  Accordingly, 
it  is  common  design  practice  to  stabilize  the  vertical 
channel  of  a three-axis  cruise  navigator  by  utiMzing 
some  external  source  of  altitude  information,  usually 
barometric  altimeter  data. 

The  initial  IGI  Simulator  developed  by  Myers  and 
Butler  incorporates  an  error  model  for  the  Litton 
LN-15  baro-inertial  navigator.  This  error  model  was 
derived  and  documented  in  a report  by  Widnall  and 
Grundy[2].  The  LN-15  employs  a local-level  wander- 
azimuth  mechanization.  In  the  vertical  channel,  the 
inertial  and  barometric  data  are  blended  by  a constant 
gain  set  of  differential  equations.  The  vertical  channel 
follows  the  high  frequency  maneuvering  of  the  aircraft 
as  measured  by  the  z accelerom.eter ; however,  the  long 
term  steady  state  solution  in  the  vertical  channel  is 
for  the  indicated  altitude  to  converge  to  the  baro-indi- 
cated  altitude. 

In  a subsonic  aircraft  the  two  largest  sources  of 
error  in  the  baro-indicated  altitude  may  be  the  standard 
setting  error  and  a scale  factor  error.  The  standard 
setting  error  is  related  to  the  variation  in  the  height 
of  a constant  pressure  surface  (the  pattern  of  "highs" 
and  "lows").  If  the  altimeter  feeding  the  INS  is  left 
set  at  standard  pressure  during  an  entire  flight,  then  the 
one-sigma  level  of  this  variation  can  be  of  the  order  of 
500  feet.  The  scale  factor  error  is  related  to  the 
temperature  of  the  atmosphere  differing  from  the  standard 
day  temperature  profile.  On  a cold  day,  the  atmosphere 
shrinks  and  a particular  altimeter  reading  is  obtained 
at  a lower  true  altitude.  The  reverse  occurs  on  a hot 
day.  A typical  scale  ^fector  error  is  3%.  At  30,000  feet 
altitude  this  would  be  a significant  error  of  900  feet. 

Both  the  standard  setting  error  and  the  scale  factor  error 
were  included  in  t'he  ii>iLtial  version  of  the  IGI  Simulator. 

In  the  design  of  practical  real-time  recursive  filters 
to  blend  inertial  navigation  and  other  (in  this  case  GPS 
measurement)  data,  one  cannot  utilize  an  "optimal"  filter. 
That  is,  one  cannot  have  modeled  in  the  filter  all  the 
sources  of  error  in  the  navigation  data.  One  designs  a 
"sub-optimal"  filter,  which  has  m.any  fewer  states  than 
the  sources  of  error.  The  initial  IGI  simulator  included 
fifty-two  states  model ing  sources  of  inertial  and  GPS 
error  and  their  propagation  dynamics.  The  suboptimal  fil- 
ter which  blended  the  GPS  and  inertial  data  had  sixteen 
states. 
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One  of  the  sixteen  states  of  the  filter  modeled 
the  altimeter  error  of  the  baro-inertial  system.  To 
minimize  the  number  of  states  in  the  filter  only  one 
altimeter  error  state  was  used.  This  state  was  defined 
to  be  scale  factor  error  and  was  modeled  in  the  filter 
as  a random  constant.  Myers  and  Butler  reported that 
this  vertical  channel  design  was  not  satisfactory.  If 
the  truth  model  contained  both  the  standard  setting 
error  and  a scale  factor  error  of  only  1%,  then  the 
filter  diverged  from  correct  estimates  of  vertical  velo- 
city, altitude,  latitude,  and  longitude. 

These  initial  results  with  the  IGI  simulator  raised 
issues  concerning  vertical  channel  design  associated  with 
the  choice  of  state  variables  in  the  recursive  filter  and 
use  of  these  state  variables  to  model  all  significant 
related  sources  of  error.  Should  two-state  variables  be 
used  in  the  filter  to  model  altimeter  error,  or  is  one 
sufficient?  If  only  one  state  is  used,  should  it  be  a 
bias-like  error  model  or  should  it  be  scale-factor  error 
model?  How  can  an  assumed  white  noise  driving  a single 
error  state  be  used  to  model  the  effects  of  other  sources 
of  error?  These  issues  are  addressed  in  this  report. 

1 . 3 Outline  of  Report 

The  IGI  Simulator  is  used  to  evaluate  alternate 
Kalman  filter  vertical  channel  designs.  Section  II 
summarizes  the  truth  model  provided  by  the  simulator. 

The  error  models  of  the  baro-inertial  navigator  and  of 
the  GPS  measurements  are  presented.  A F4  aircraft  tra- 
jectory has  been  selected  to  drive  the  error  models. 

This  trajectory  is  also  described  in  Section  II.  The 
baro-inertial  navigation  errors  produced  by  the  assumed 
sources  of  error  and  by  the  assumed  trajectory  are  plotted 
and  presented. 

Section  III  presents  a basic  recursive  (Kalman) 
filter  for  blending  the  inertial  navigation  and  GPS 
measurement  data.  Then  three  alternate  vertical  channel 
filter  designs  are  presented. 

1.  Filter  A has  two  states  representing  the  altimeter 
sources  of  error,  an  altimeter  bias  state  and  an 
altimeter  scale  factor  error  state. 

2.  Filter  B has  a single  altimeter  error  state,  an 
altimeter  bias  state. 

3.  Filter  C has  a single  altimeter  error  state,  a 
scale  factor  error  state. 


A 


-3- 


Appropriate  expressions  are  developed  for  the  spectral 
densities  of  the  assumed  noises  driving  these  states. 
These  noises  model  the  important  sources  of  error  that 
have  not  been  included  as  states. 

Section  IV  presents  the  results  of  running  each  of 
these  three  filter  designs  in  the  IGI  simulator  with  the 
same  truth  model  for  the  errors  and  with  the  same  F4 
trajectory.  The  comparative  performance  is  discussed. 

Conclusions  are  presented  in  Section  V. 
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SECTION  II 


SIMULATION  ERROR  MODELS  AND  TRAJECTORY 


2 . 1 Error  State  Propagation  Equations 

The  IGI  simulator  has  organized  the  error  models  into 
a system  of  linear  first  order  stochastic  differential 
equations 

X = F(t)  X + w (2-1) 


where  x is  the  state  vector,  F is  the  fundamental  matrix,  and 
w is  a vector  of  white  noise  disturbances. 

Fifty  four  state  variables  are  included  in  the  state 
vector,  as  shown  in  Table  2-1.  The  first  nine  state  variables 
are  the  basic  position,  velocity,  and  attitude  errors  common 
to  all  three-axis  inertial  navigators.  State  10  is  the 
altimeter  scale  factor  error.  State  11  is  the  vertical 
acceleration  error  variable  of  the  third-order  baro-inertial 
vertical  channel  of  the  LN-15.  State  12  is  the  GPS  user 
equipment  cloclc  phase  error.  State  13  is  one  of  the  user 
clock  frequency  error  states.  States  14,  15,  and  16  are 
the  gyro  g-insensitive  drift  rates.  These  first  sixteen  states 
have  some  correspondence  to  the  states  of  the  sixteen  state 
filter  evaluated  by  Myers  and  Butler  in  Ref.  [1].  This 
ordering  of  the  states  was  chosen  in  Ref.  [1]  to  emphasize 
this  correspondence,  and  this  ordering  is  retained  here. 

States  17  through  34  are  additional  gyro-related  sources 
of  error.  States  35  through  46  are  accelerometer  sources  of 
error.  State  47  is  the  altimeter  zero  setting  error.  States 
48,  49,  and  50  are  the  deflections  of  gravity  and  gravity 
anomaly.  States  51  and  52  are  additional  user  clock  error 
states.  States  53  and  54  are  two  additional  sources  of 
altimeter  error,  the  coefficient  of  static  pressure  measure- 
ment error,  and  the  altimeter  lag.  The  first  52  state  variables 
are  the  same  as  selected  by  Myers  and  Butler  in  Ref.  [1]. 

States  53  and  54  have  been  added  in  this  study  to  provide 
greater  fidelity  for  the  altimeter  error  model. 


-5- 


Table  2-1  Error  Model  State  Variables 


Non-zero  elements  of  partitions  of  the  fundamental 
matrix  are  presented  in  Table  2-2,  parts  a,  b,  c,  d,  and  e. 
Part  a is  the  upper  left  nine  by  nine  partition  of  the 
general  INS  error  differential  equations  governing  position, 
velocity,  and  attitude  errors  of  any  three  axis  INS.  Part  b 
gives  the  added  elements  in  the  upper  left  11  by  11  partition 
peculiar  to  the  baro-inertial  LN-15  and  its  third  order 
vertical  channel  mechanization.  Part  c identifies  the  non- 
zero elements  of  the  columns  associated  with  the  gyro  error 
sources.  Part  d identifies  the  non-zero  elements  of  the 
columns  associated  with  the  accelerometer,  gravity,  and 
additional  altimeter  error  sources.  Part  e gives  the  parti- 
tions associated  with  the  four  clock  error  states. 

Table  2-3  defines  the  notation  used  in  the  fundamental 
matrix  elements  of  Table  2-1  and  in  the  noise  spectral  density 
matrix  elements  of  Table  2-4. 

Table  2-4  identifies  the  non-zero  elements  of  the  noise 
density  matrix.  Only  some  of  the  elements  on  the  main 
diagonal  are  chosen  to  be  non-zero  in  this  error  model. 

Error  source  initial  values  and  statistics  are 
summarized  in  Table  2-5.  The  error  sources  here  are  grouped 
by  model  type:  random  walks,  first  order  Markov  processes, 
and  random  constants.  For  the  random  walks,  the  initial 
values  of  the  states  are  given  plus  the  noise  spectral  density 
of  the  driving  noises.  (Clock  phase  error  is  included  here 
for  convenience,  although  it  is  not  simply  a random  walk.) 

For  the  first-order  Markov  processes,  the  one-sigma  values 
and  the  inverse  correlation  times  are  given.  The  initial 
conditions  for  these  processes  have  arbitrarily  been  chosen 
to  be  the  positive  one-sigma  value.  For  the  random  constants, 
the  selected  values  are  generally  the  positive  one-sigma 
value  for  each  error  source,  except  that  in  the  case  of  gyro 
and  accelerometer  input  axis  misalignments  both  positive  and 
negative  values  have  been  used  to  break  up  the  orthogonality 
of  the  instruments. 

The  initial  value  for  the  z (azimuth)  gyro  g-insensitive 
drift  rate  (state  16)  of  -.295®/hr  when  combined  with  the  z 
gyro  sensitivity  to  z specific  force  (state  22)  of  0.300‘’/hr/g 
in  a one-g  field  produces  a net  initial  z gyro  drift  rate  of 
.OOSVhr. 

Ref.  [3]  presents  the  state  vector,  the  fundamental 
matrix,  the  driving  noise  spectral  densities,  and  the  initial 
conditions  used  in  generating  the  earlier  results  reported  in 
Ref.  [1].  Some  of  the  changes  made  for  this  report  include: 
two  additional  barometric  altimeter  error  states  (states  53 
and  54)  have  been  included.  The  definition  of  state  16  has 
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Table  2-2b 


I Fundamental  Matrix  for  LN-15  Vertical  Channel,  Partition  of 

j First  Eleven  State  Variables  (Added  to  Fundamental 

j Elements  in  Part  a) 

'i 


Table  2-2d 


Fundamental  Matrix,  Partitions  of  Accelerometer, 


Altimeter,  and  Gravity  Disturbance  State  Variabes 


Latitude  of  vehicle 
Earth  rotation  rate 
Earth  radiuft 

Magnit  ude  of  gravity  vector 

Componente  of  vehicle  velocity  with 
reapect  to  earth 

Componente  of  apecific  force 


■ n cos  L 
n 

j • n ein  L 


I 

. Components  of  earth  rate 


- -v^/R 


V 

e 


/R 


Components  of  angular  velocity  of 
E-N-2  frame  with  respect  to 
earth 


v^  tan  L/R 


Components  of  angular  velocity  of 
E-N-Z  frame  with  respect  to 
inertial  space 


^42  ’ % * "r  ''i>  * On  V«>*’  ^ 

'43  ■ 0*  0,  * p„ 

'44  - -0,  ^ ^ 

'52  • -*  "n  ^ - On  v,/co.^  L 


■53  • o„  0,  - e,  k, 

^63  - - ‘On  ♦ 0^ 


'92 


♦ p,  tan  L 

n s 


1*  ''2* 


Coefficients  in  altitude  channel  baro^* 
inertial  loop 


‘“y 


I 


z 


coa  o,  coaine  of  the  wander  angle 

■in  a,  aine  of  the  wander  angle 

Componente  of  apecific  force  along  the 
LN^IS  Xry.B  axea 

CoR^nenta  of  angular  velocity  of  the 
E-N-z  frame  with  reapect  to  inertial 
■pace  along  tha  LN-15  x^y  axea 

Up  component  of  earth  rate 


Vehicle  altitude 


Vehicle  ground  apeed 


Correlation  diatance  of  altimeter 
error 


d ,d  .d 
ge  gn  gz 


Correlation  diatancas  of  gravity 
deflactiona  and  anomaly 


’alt 


lo  amplitude  of  altimeter  error  e^^ 

po 


• 0 * 0 

ge  gn'^gz 


lo  amplitude  of  gravity  diaturbances 


’tru 


lo  amplitude  of  clock  random  frequency 
•rror 


tru 


Inverse  correlation  time  of  clock 
random  frequency  error 


Table  2-4  Simulation  Noise  Density  Matrix,  Non  Zero  Elements 


Diagonal 

Element 

State 

Variable 

Noise 

Density 

12 

'tu 

14 

DXf 

^DXf 

15 

DVf 

^DYf 

16 

1 DZf 

^’DZf 

35 

AB 

^ABx 

36 

AB 

y 

^ABy 

37 

AB 

z 

N 

[ ABz 

47 

i 

e 

1 po 

[ 

N = 2 _ v/d 

epo  alt  alt 

48 

^ 6g 

e 

N ^ = 2 v/d 

ge  ge  ge 

49 

6g 

1 

N ^ = 2 v/d 

gn  gn  gn 

50 

N = 2 v/d 

gz  gz  gz 

I 

52  1 

6t 

ru 

! 

^tru  “ ^ ^ tru  ^tru 

Table  2-5 

Error  Source  Initial  Values  and  Statistics 


RANDOM  WALKS 


State 

Variable 

Number 

Error  Source 

Znltial 

Value 

Noiae 

Spectral  tianaity  N 

14,  IS 

X,Y  (level)  9yro  drift 

rates 

.003Vhr 

(.001Vhr)*/hr 

16 

Z (aximuth)  9yro  drift 
rate 

-.295*/hr 

(.005*/hr)’/hr 

13 

Clock  Phaae  Error 

1000  ft. 

1 ft*/sae 
(10  pg)^/hr 

)S,  36 

X.y  (horixontal)  acce- 
lerometer biases 

SO  U9 

37 

Z (altitude)  accalero- 
saeter  bias 

100  U9 

(10  wgl^/hr 

FIRST  ORDER  NARROV  PROCESSES 


State 

Variable 

Number 


Error  Source 

1 

Initial  and 
lo  Value 

Xnverae  Correlation 
Time  0 

Sarometric  altimeter 
time-varyms  error 

500  ft. 

v/(250  n.al.) 

East  deflection  of 
9ravity 

2«  vg 

v/(10  n.sl.) 

North  deflection  of 
9ravlty 

17  ug 

v/(10  B.al.) 

Gravity  anomaly 

35  ug 

T/(t0  n.al.) 

Clock  random 
frequency 

10  ft/sac 

1 

1/(7200  sscl 

random  constants 


State 

Variable 

N^nber 


Error  Source 


17  to  22 

C-aensitiv#  vyro  drift 
coefficients 

23  to  2h 

C^-aensitive  qyro  drift 
coefficients 

26,  27 

Z.y  gyro  scale  factor 
errors 

2B 

S gyro  scale  factor  error 

29  to  34  1 

Gyro  input  axia  miaalign- 

menta 

38  to  40 

j 

Accelerometer  scale 
factor  errors 

42,  44 

X,  y accelerometer  input 
axis  misalignment  about  Z 

41,  43 

4S,  46 

Other  accelerometer  input 
axis  misalignments 

10 

tsroastric  sltlastsr 
seals  factor  srror 

51 

Clock  aging  blaa  srror 

13 

Clock  frequency  bias  ini- 
tial condition 

53 

Coefficient  of  Static 

Pressure  Measurement 

Error 

54 

Sarometric  time  delay 

Initial 

Value 


O.JVhr/9 

O.OIVhr/g* 

)0D  pgn 

1.000  ppo 

t40  arc  aac 
ISO  ppoi 
tllO  arc  sac 
tJO  arc  sac 
0.01 

1.0  s lo’’ft/i 

1.0  (t/sac 


O.IS  sacs 


L3 


been  changed  so  that  the  state  is  the  g-insensitive  (free-fall) 
z gyro  drift  rate  rather  than  the  drift  rate  during  one-g  of 
z specific  force.  Similarly  the  definition  of  state  37  has 
been  changed  so  that  the  state  is  the  free  fall  z accelerometer 
bias  rather  than  the  accelerometer  bias  during  one-g  of  z 
specific  force.  The  definitions  are  now  consistent  with  those 
used  in  Ref.  [2],  The  spectral  density  of  the  noise  driving 
the  clock  phase  error  (state  12)  has  been  reduced  from  100  to 
1 ft^/sec.  The  one-sigma  value  of  the  first-order  Markov 
clock  random  frequency  (state  52)  has  been  increased  from 
10“6  to  10  ft/sec,  and  its  correlation  time  has  been  lengthened 
from  1800  sec  to  7200  sec.  Some  of  the  gyro  and  accelerometer 
input  axis  misalignments  were  changed  to  negative  values  to 
break  up  the  orthogonality  of  the  instruments.  The  first  order 
Markov  processes  are  now  s'-arted  at  positive  one-sigma  values 
rather  than  at  zero. 


2.2  Vertical  Channel  Error  Model 


Of  primary  concern  in  this  analysis  is  the  performance  of 
the  vertical  channel  of  the  integrated  GPS/inertial  navigation. 
Some  discussion  of  the  sources  of  error  in  the  vertical  channel 
of  a baro/inertial  navigator  therefore  is  in  order. 

A block  diagram  of  the  error  equations  of  the  third-order 
LN-15  vertical  channel  is  shown  in  Fi'-ure  2-1. 


da 


Figure  2-1 


Third  Order  Baro-Stabilized  Vertical  Channel 
Error  Model 
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The  closed-loop  altitude  error  6h,  the  vertical  velocity 
error  dv^f^and  the  LN-15  vertical  acceleration  error  estimate 
variable  da  are  governed  by 


dh  = dv^  - k^(6h  - dhj^)  (2-2) 

dv^  = da  - k^Cdh  - dhj^)  - da  (2-3) 

da  = - dhj^)  (2-4) 

The  values  of  the  loop  gains  kj^,  k2,  and  k3  used  in  the  LN-15 
are 


'll 


* 


3.0 

X 

10-2 

-1 

sec 

3.0 

X 

lO"'* 

-2 

sec 

1.0 

X 

10-^ 

-3 

sec 

A 


This  set  of  gains  results  in  a stable  altitude  channel  with'^ 
characteristic  time  constant  of  100  secs. 

The  variable  da  represents  the  inertial  vertical  accelera- 
tion error  due  to  vertical  accelerometer  bias  (AB^) , vertical 
accelerometer  scale  factor  error  (ASFz) , vertical  accelerometer 
misalignments  (ZA^  and  ZAy)  about  the  platform  x and  y (level) 
axes,  gravity  anomaly  dg2/  gravity  computation  error  (•2g/R)dh, 
and  platform  misalignments  Eg  and  e^,  plus  other  sources. 


da  = AB  + f ASF 
Z 2 Z 


f 

n 


G-  + 
e e 


^n 


(2-5) 


See  row  six  of  the  fundamental  matrix  to  identify  all  the  terms. 
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6h5  represents  the  baro  altinoter  error  and  is  the  sum 
of  altimeter  error  due  to  altimeter  bias  (Cp^) , altimeter 
scale  factor  (ey^gf ) , static  pressure  measurem.ent  error  (Cgp) 
and  altimeter  lag  (1^)  when  the  aircraft  climjDs  or  descends 


6h,  = 

b 


+ h e 


hsf 


+ c 


sp 


2 

V 


(2-6) 


where  h is  aircraft  altitude,  v is  aircraft  speed,  and  Vz  is 
the  vertical  velocity. 

The  altimeter  bias  ep  , or  standard  settina  error,  or 
variation  in  height  of  a cSnstant  pressure  surface  changes 
slowly  with  time  due  primarily  to  the  aircraft  motion  through 
the  weather  pattern  and  to  a lesser  extent  due  to  the  motion 
of  the  weather  system.  The  rms  variation  of  the  altitude  of 
the  constant  pressure  surface  has  a bounded  magnitude.  This 
error  is  modeled  as  a first  order  Markov  process  given  by 


= -uj,,.e  -fw 

' ‘^0  ^0 

(2-7) 

^alt  = ^/^alt 

(2-8) 

alt  ^ ^alt  ^alt^ 

(2-9) 

where 

= correlation  distance  of  the  weather  system 

= standard  deviation  of  the  variation  in  altitude 
of  a constant  pressure  surface 

= power  spectral  density  of  the  white  noise  process 
'^Po 

V = aircraft  speed 


The  altimeter  scale  factor  e^sf  represents  the  error  due 
to  deviation  of  atmospheric  temperature  from  the  assumed 
standard  temperature  profile.  It  can  be  shown  that  the  error 
in  indicated  altitude  due  to  a non  standard  temperature  is  of 
the  form 
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X h 


(2-10) 


®temp  ^hsf 


so  that  the  error  due  to  non  standard  temperature  is  interpreted 
as  an  altimeter  scale  factor  error.  This  error  varies  very 
slowly  with  time  and  location,  such  that  it  can  be  assumed  to 
remain  invariant  over  typical  aircraft  flight  durations.  The 
scale  factor  error  is  therefore  modeled  as  a random  constant 


'hsf 


= 0 


(2-11) 


with  standard  deviation  o, 

hsf 


The  barometer's  indication  of  altitude  is  based  on  static 
pressure  (stationary  aircraft) . This  static  pressure  must 
be  inferred  from  pressure  measurements  made  by  a pitot-static 
tube  aboard  a moving  aircraft.  It  can  be  shown  assuming  an 
exponential  atjiiosphere  that  the  altimeter  error  egp  due  to 
erroneous  interference  of  the  static  pressure  is  approximately 


e 


sp 


(2-12) 


where  v is  the  aircraft 
invariant  with  altitude 
constant 


speed.  The  coefficient  Cgp  is  nearly 
or  density  and  is  modeled  as  a random 


sp 


= 0 


(2-13) 


with  standard  deviation  a 

sp 

The  barometric  time  delay  represents  the  time  required 
for  the  static  pressure  in  the  cavity  of  the  pressure  trans- 
ducer to  adjust  to  the  static  pressure  at  the  port  by  flow 
of  air  through  the  tubing  when  the  aircraft  climbs  or 
descends.  This  time  constant  is  essentially  invariant  with 
time  and  is  modeled  as  a random  constant 


^b  = 0 


(2-14) 


with  standard  deviation  o,. 

‘b 
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At  subsonic  speeds  and  at  low  altitude,  the  standard 
setting  error  may  be  the  most  significant  error.  At  subsonic 
speeds  and  at  high  altitude  the  scale  factor  error  is  usually 
the  most  significant  error.  At  supersonic  speeds,  the  static 
pressure  measurement  error  may  be  the  most  significant.  The 
altimeter  lag  is  significant  only  during  climbs  and  dives. 


2 . 3 GPS  Measurements  Error  Model 

The  GPS  Space  Segment  will  consist  of  24  satellites  in 
circular  orbits  having  12  hour  periods  and  having  inclina- 
tions of  63®.  The  satellites  will  be  distributed  in  three 
orbital  planes  with  each  plane  containing  eight  satellites  at 
45°  intervals.  The  positions  and  velocities  of  these  24 
satellites  are  included  in  the  IGI  Simulator  H] . 

Each  satellite  radiates  a pseudo-random  code  signal, 
which  is  a known  function  of  the  GPS  system  time.  The 
receiver  in  a GPS  navigation  set  cross-correlates  the 
received  signal  with  a locally  generated  replica  of  the 
pseudo-random  code  signal  to  measure  the  received  code  time 
offset.  This  time  offset  measurement  is  called  a pseudo- 
range measurement,  because  the  measured  time  offset  is  a 
function  not  only  of  the  range  from  the  satellite  to  the 
receiver  but  also  the  receiver  clock  error  relative  to  GPS 
system  time. 

In  principle,  pseudo-range  measurements  to  four  different 
satellites  are  sufficient  for  a navigation  computer  to  solve 
for  three  components  of  vehicle  position  plus  GPS  system  time. 
The  accuracy  of  the  solution  is  enhanced  by  choosing  four 
satellites  that  provide  favorable  geometry.  The  satellite 
selection  logic  in  the  IGI  simulator  identifies  the 
satellites  that  are  in  view  above  an  elevation  of  5°.  For 
all  combinations  of  four  of  these  satellites,  it  computes  the 
geometric  dilution  of  precision.  The  set  having  the  lowest 
dilution  is  selected  for  the  next  five-minute  interval. 

It  is  assumed  that  the  Kalman  filter  processes  a pseudo 
range  difference  measurement,  which  is  the  difference  between 
the  measured  pseudo  range  and  the  range  computed  based  on 
the  given  satellite  ephemeris  and  on  the  INS  indicated  position. 
Such  a difference  measurement  will  be  non-zero  in  the  IGI 
simulator  due  to  the  simulated  user  clock  phase  error  and  due 
to  the  three  components  of  INS  indicated  position  error. 

In  addition  to  these  sources  of  error  which  are  states 
in  the  truth  model,  the  pseudo  range  difference  measurement 
is  assumed  to  have  an  additive  random  error  whose  one-sigma 
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value  is  assumed  to  be  20  ft.  This  additive  random  error 
models  other  sources  of  GPS  pseudo  range  measurement  error 
including  satellite  clock  compensation  error,  satellite 
ephemeris  error,  ionospheric  retardation  compensation  error, 
tropospheric  retardation  compensation  error,  multipath 
random  error,  and  receiver  noise-related  error.  It  is 
recognized  that  many  of  these  sources  of  error  are  slowly 
varying,,  so  in  a future  revision  of  the  IGI  simulator  we 
shall  introduce  additional  states  in  the  truth  model  to 
represent  the  slowly  varying  external  ranging  errors.  The 
omission  of  this  model  refinement  in  this  present  study  is 
thought  not  to  have  a bearing  on  the  principal  results  and 
conclusions . 

A GPS  receiver  may  also  lock  on  to  the  suppressed 
carrier  of  the  GPS  signal.  The  offset  between  the  received 
carrier  frequency  and  the  locally  generated  frequency  is  a 
function  of  the  range-rate  between  the  satellite  and  the 
receiver  and  of  the  user  clock  frequency  error.  Hence,  this 
offset  is  called  the  pseudo  range  rate.  The  pseudo  range 
rate  is  usually  integrated  to  produce  a delta-range  measure- 
ment. When  available,  carrier  tracking  with  the  delta 
pseudo  range  measurement  provides  a more  precise  measure 
of  the  change  in  pseudo  range  than  can  be  obtained  by 
differencing  successive  pseudo-range  measurements. 

In  the  initial m and  present  version  of  the  IGI 
Simulator,  the  delta  pseudo  range  measurements  are  not 
simulated.  In  their  place,  pseudo  range  rate  measurements 
are  simulated.  In  a future  version  of  the  IGI  Simulator, 
delta  pseudo  range  measurements  will  be  introduced. 

It  is  assumed  that  the  Kalman  filter  processes  a pseudo 
range  rate  difference  measurement,  which  is  the  difference 
between  the  measured  pseudo  range  rate  and  the  range  rate 
computed  based  on  the  given  satellite  ephemeris  and  on  the 
INS  indicated  velocity.  Such  a difference  measurement  will 
bo  non-zero  in  the  IGI  Simulator  due  to  the  simulated  user 
clock  frequency  error  states  and  due  to  the  three  components 
of  INS  indicated  velocity  error. 

In  addition  to  the  sources  of  error  which  are  states 
in  the  truth  model,  the  pseudo  range  rate  difference  measure- 
ment is  assumed  to  have  an  additive  random  error  whose 
one-sigma  value  is  assumed  to  be  1//5  = 0.45  ft/sec.  This 
error  in  a pseudo-range  rate  measurement  is  equivalent  to  an 
error  in  a delta-pseudo-range  measurement  of  /5  ft  lo  with  a 
5 sec  integration  interval.  A random  error  of  /5  ft  lo  is 


-19- 


the  result  of  the  clock-phase  white 
density  of  1 ft^/sec  and  integrating 


noise 
for  5 


having 

sec. 


spectral 


uses  rfoS^stati^nfoev"'^  Present  version  of  the  IGI  Simulator 
uses  a four  state  clock  error  model  (state  variables  12,  13, 

liven  i;  F?glrrt2'^^“"  equations  is 


Figure  2-2  User  Clock  Error  Model 


Note  in  this  model,  the  total  clock  frequency  error  is  the 

alS  f ^ ^ Slowly 

Markov  error.  Both  the  bias  and  Markov 
states  are  presently  included  as  error  sources  in  the  pseudo- 

initial  version  [U  of  the  IGI 
include  the  effect  of  the  Markov  state 
frequency  error  in  the  simulated  pseudo-range  rate  measure- 
monts.  Howevor,  tho  ono-si,™  value  of  lO'?  tt“lc  Sat  Sas 
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assigned  to  the  first-order  Markov  process  was  so  small, 
that  this  omission  may  not  have  caused  problems  in  the  simu- 
lation results. 

It  is  assumed  that  measurements  are  available  every 
5 sec.  The  measurement  set  includes  eight  measurements,  which 
are  the  measured  pseudo  range  and  pseudo  range  rates  to  each 
of  the  four  selected  satellites.  Periods  of  jamming  are 
simulated  by  omitting  the  m.easurements  for  specified  periods. 


2 . 4 F4  Aircraft  Trajectory 

The  precomputed  reference  trajectory  which  drives  the 
error  simulation  model  is  representative  of  an  F4  tactical 
mission  profile.  Figure  2-3  shows  the  ground  track  plot, 
while  Figure  2-4  shows  the  altitude  profile.  In  order  to 
reduce  the  flight  time  simulated,  only  the  high  dynamics 
segment  of  the  mission  with  appropriate  lead  in  and  lead  out 
is  used.  This  situation  is  reflected  in  the  altitude  profile 
of  Figure  2-4.  An  examination  of  Figures  2-3  and  2-4  shows 
that  between  300  and  400  secs,  the  aircraft  executes  a 
"figure  eight"  maneuver  while  losing  altitude.  Not  evident 
in  the  ground  track  plot  are  the  rapid  zig-zag  maneuvers 
executed  by  the  aircraft.  These  are  illustrated,  however, 
by  the  yaw  profile  plot  of  Figure  2-5.  In  some  of  these 
maneuvers,  maximum  bank  angles  of  70°  are  used,  with  associated 
load  factors  of  3g.  One  pull-up  has  a load  factor  of  5g. 

The  mission  scenario  envisions  a period  of  GPS  signal 
jamming  starting  at  T=685  secs  just  before  the  aircraft 
begins  to  descend  towards  a hypothetical  target  and  ending 
at  T=1110  secs  as  the  aircraft  is  climbing  away  from  the 
target.  It  is  during  this  interval  of  jamming  that 
differences  can  be  expected  in  altitude  and  vertical  velocity 
navigation  accuracy  of  alternate  vertical  channel  Kalman 
filter  mechanizations. 


2 . 5 Baro-Inertial  Navigation  Errors 

In  this  subsection  are  exhibited  the  position  and  velocity 
errors  of  the  simulated  baro-inertial  navigator  as  forced  by 
the  dynamics  of  the  F4  aircraft  trajectory. 

In  addition  to  the  initial  error  source  values  and  noise 
statistics  presented  in  Table  2-5,  initialization  of  the  INS 
error  model  involves  the  selection  and/or  computation  of 
appropriate  initial  values  for  INS  position  errors  (6X,  6L,  6h) 
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Figure  2-4  f-4  Mission  Altitude 


velocity  errors  (6Vq,  Sv^)  r platform  attitude  errors 

(eg,  e^)  and  the  vertical  acceleration  variable  6a. 

At  the  start  of  the  simulation,  the  aircraft  is  cruising 
at  constant  altitude.  Representative  and  consistent  initial 
values  for  the  ten  states  mentioned  above  must  be  determined 
for  this  flight  condition. 

Initial  values  for  the  east  and  north  attitude  errors 
are  assumed  to  correspond  to  1 nautical  mile  of  north  and 
east  position  errors 


£^(0)  = -1  arc  min 
En^O)  = +1  3rc  min 

The  corresponding  latitude  error  and  longitude  error  are 
assumed  to  be: 


6L(0)  = -£^(0) 


6X(0) 


cos  L 


(2-15) 

(2-16) 


This  correlation  between  horizontal  position  errors  and 
horizontal  components  of  attitude  error  is  typical  of  Schuler 
oscillation  inertial  navigation  errors. 

In  order  to  avoid  a large  transient  in  the  vertical 
channel  response,  it  is  assumed  that  flight  at  constant 
attitude  has  been  in  progress  sufficiently  long  so  that  the 
closed  loop  altitude  error  is  equal  to  the  baro-altimeter 
error.  The  initial  value  for  the  altitude  error  is  therefore 
given  by 

6h(0)  = e^  (0)  + e^g^(O)  x h(0)  + Cgp(O)  x v^(0) 

(2-17) 
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using  the  initial  values  for  epQ,  sj^sf,  and  Cgp  presented  in 
Table  2-5,  with  h(0)  = 23335  ft,  v(0)  = 819  ft/sec,  then 


6h(0)  » 1300  ft 


Typical  values  of  the  velocity  errors  of  a baro-stabilized 
inertial  navigation  system  during  cruise  at  constant  altitude 
are  of  the  order  of  5 ft/sec  for  the  east  and  north  velocity 
errors  and  of  the  order  of  a tenth  of  a ft/sec  for  the  vertical 
velocity  error.  Accordingly,  the  initial  velocity  errors 
have  been  chosen  to  be 


6v  (0)  = 5.0  ft/sec 
e 

6Vn(0)  = 5.0  ft/sec 
6v^(0)  = 0.1  ft/sec 

.K  In  steady  state  the  vertical  acceleration  error  variable 
6a  (state  variable  11,  which  is  the  integral  of  the  difference 
between  the  computed  and  barometric  altitude)  compensates 
for  the  inertial  vertical  acceleration  error  and  permits  the 
steady  state  difference  between  the  computed  altitude  and 
barometric  altitude  to  be  zero.  In  the  simulation  runs 
conducted  here,  the  initial  value  of  6a  compensates  for 
vertical  acceleration  error  due  to  vertical  accelerometer 
bias,  vertical  accelerometer  scale  factor  error,  gravity 
anomaly,  and  gravity  computation  error,  the  initial  value  for 
6a,  is  therefore  given  by 


6a(0)  = AB,(0)  + ASF  (0)  x g + 6g,(0)  + ^ 6h(0) 

Z Z Z iv 

(2-18) 


Using  the  initial  values  for  AB^,  ASFz  and  6gz  presented  in 
Table  2-5,  and  6h(Q)  as  computed  by  Eq.  (2-17),  the  appropriate 
initial  value  of  6a(0)  is 


6a(0) 


1.38  X 10  ^ ft/sec 


The  data  of  Table  2-5  together  with  the  relations  and 
initial  values  for  the  basic  position,  velocity  and  attitude 
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error  states,  and  for  the  variable  6a  presented  above  complete 
the  INS  error  model  initialization. 

The  resulting  position  and  velocity  errors  of  the  baro- 
inertial  system,  unaided  by  GPS  measurements,  are  shown  in 
Figures  2-6,  2-7,  and  2-8. 

The  horizontal  position  errors  are  shown  in  Figure  2-6. 

Both  the  one  n.m.  initial  east  and  north  position  error  show 
an  initial  upward  trend  due  to  the  +5  ft/sec  east  and  north 
velocity  errors.  Both  plots  display  a segment  of  the  familiar 
Schuler  oscillation.  The  x (east)  and  y (north)  accelerometer 
bias  and  effective  misalignment  errors  (30  arc  secs  below  the 
level  plane)  are  the  same,  so  that  these  sources  of  error 
have  the  same  effect  on  east  and  north  position  errors. 

However,  the  ratio  of  east  to  north  deflection  of  gravity  is 
1.53.  This  is  also  (approximately)  the  ratio  of  the  changes 
from  initial  to  peak  value  of  the  east  and  north  position 
errors,  which  has  a value  of  1.49. 

Figure  2-7  shows  the  INS  horizontal  velocity  errors 
as  functions  of  flight  time.  The  downward  trend  together 
with  the  inflections  of  the  plots  at  zero  crossing  points 
(where  the  respective  position  errors  reach  peak  values)  are 
associated  with  the  Schuler  oscillation.  Between  300  and  400 
seconds,  the  aircraft  executes  a right  turn  circle  followed 
by  a left  turn  circle  as  shown  on  the  ground  track  plot  of 
Figure  2-3.  The  fluctuation  in  the  velocity  errors  during 
this  interval  are  due  to  the  misalignment  errors  of  the  x (east) 
and  y (north)  accelerometer  about  the  vertical  axis  which 
cause  the  north  and  east  components  of  acceleration  during  the 
turns  to  be  misinterpreted  respectively  as  having  small 
components  of  east  and  north  specific  forces.  The  larger 
fluctuations  in  the  east  velocity  errors  are  due  to  the  larger 
effective  misalignment  of  the  x accelerometer  from  the  east 
axis  as  shown  in  Figure  2-9.  The  subsequent  zig-zag  maneuvering 
of  the  aircraft  shown  in  Figure  2-5  results  in  noticeable 
east  velocity  error  fluctuations.  The  north  velocity  error 
fluctuations  are  much  smaller  because  again  the  y accelerometer 
has  a smaller  misalignment  and  also  because  the  east  specific 
force  is  less  than  the  north  specific  force  when  zig-zagging 
about  an  easterly  heading.  The  yaw  maneuvering  between  900 
and  1100  secs  shown  in  Figure  2-5  results  in  much  smaller  east 
velocity  error  fluctuations  because  the  aircraft  is  traveling 
southwards  during  this  time. 

Figure  2-8  shows  the  INS  altitude  and  vertical  velocity 
errors.  The  altitude  error  of  the  baro-inertial  system 
sluggishly  follows  the  total  baro  altimeter  error  which  is 
dominated  by  the  altimeter  scale  factor  error  and  the 
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Figure  2-6  INS  Horizontal  Position  Errors 
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Figure  2-9  X and  Y Accelerometer  Misalignment  from 
East  and  North 


altimeter  bias  error.  The  latter  error  is  modeled  as  a first 
order  Markov  process  in  the  error  model  and  assumes 
particularly  severe  values  (up  to  1150  ft)  in  this  simulation 
run. 

The  low  frequency  content  of  the  vertical  velocity 
error  is  seen  to  follow  sluggishly  the  rate-of-change  of  the 
altimeter  error.  High  frequency  variations  in  the  vertical 
velocity  error  due  to  maneuver— dependent  acceleration  error 
are  also  evident  in  the  figure. 
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SECTION  III 


FILTER  ERROR  MODELS 


The  IGI  simulator  currently  mechanizes  a Kalman  filter 
for  estimating  navigation  errors  by  processing  GPS  pseudo 
range  and  pseudo  range  rate  measurements.  The  nominal  tra- 
jectory about  which  the  Kalman  filter  equations  are  linear- 
ized is  that  indicated  by  the  unaided  inertial  navigation 
system,  i.e.,  the  INS  indications  of  position  and  velocity. 

In  this  section,  three  alternate  filter  mechanizations 
are  discussed.  These  mechanizations  differ  in  the  manner 
in  which  the  altimeter  error  is  modeled.  Section  3.1  first 
presents  the  basic  filter  state  variables  common  to  the 
three  cases.  Driving  noises  for  these  filter  states  are 
designed  to  account  for  sources  of  error  not  included  as 
filter  states.  Section  3.2  discusses  a two-state  model  for 
the  altimeter  error  which  includes  an  altimeter  bias  state 
and  an  altimeter  scale  factor  error  state.  Section  3.3  dis 
cusses  the  single  altimeter  bias  error  state  filter  model 
for  the  altimeter  error,  while  section  3.4  describes  the 
single  altimeter  scale  factor  error  state  filter  model. 
Section  3.4  discusses  the  models  for  the  GPS  measurements 
employed  by  the  filter. 

3.1  Inertial  and  Clock  Error  Models 

The  number  of  states  selected  for  inclusion  in  the  fil- 
ter mechanization  is  a compromise  between  the  requirements 
to  obtain  theoretically  optimal  performance  and  the  re- 
quirements for  filter  implementation  with  reduced  computa- 
tion capacity.  Table  3-1  presents  the  state  variables  to 
be  estimated  by  the  Kalman  filter  designs  investigated  here. 
Not  defined  in  the  table  are  the  one  or  two  states  of  the 
altimeter  error  model. 
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Table  5-1 


r 


Filter  State  Variables 


STATE 

INITIAL 

FILTER 

VARIABLE 

SYMBOL 

DEFINITION 

STANDARD  DEVIATION 

NUMBER 

VALUE 

UNITS 

1 

Longitude  Error 

3.94  X lo"^ 

Radians 

2 

6L 

Latitude  Error 

2.905  X lO"^ 

Rad ians 

3 

6h 

Altitude  Error 

1500 

Feet 

4 

6v 

e 

East  Velocity  Error 

5 

ft/sec 

5 

6v 

n 

North  \clocity  Error 

5 

ft/sec 

6 

6v 

z 

V'  e r t i e a 1 Velocity 
Error 

1 

f t/sec 

7 

East  Attitude  Error 

2.91  X lO"** 

Radians 

8 

North  Attitude  Error 

2.91  X 10“'* 

Radians 

9 

Azimuth  Error 

5.0  X 10“'* 

Radians 

10 

6t 

u 

Clock  Phase  Error 

1000 

Feet 

11 

6t 

ru 

Clock  Frequency 
Error 

10 

ft/sec 

12 

DXf 

X Gyro  Drift 

1.4554  X 10“® 

rads/sec 

13 

Y Gyro  Drift 

1.4554  X 10“® 

rads/sec 

14 

DZf 

Z Gyro  Drift 

2.42  X 10“® 

rads/sec 

15 

Filter  Vertical 

9.1793  X 10“^ 

f t/sec^ 

Acceleration  Error 
Variable 

(Altimeter  Error 
States  to  be 
Def ined ) 


The  first  six  states  represent  estimates  of  errors  in 
the  INS  indications  of  vehicle  position  and  velocity.  The 
user's  best  estimate  of  position  and  velocity  is  obtained 
by  subtracting  the  estimate  of  position  and  velocity  error 
from  the  INS  indications  of  these  quantities.  In  other 
words,  a positive  position  or  velocity  error  estimate 
implies  that  the  INS  indication  of  position  and  velocity 
is  greater  (more  positive)  than  the  best  estimate  of  posi- 
tion and  velocity. 

Positive  values  of  the  attitude  error  variables  about 
a given  axis  implies  that  the  platform  is  rotated  posi- 
tively (by  the  right  hand  rule)  about  that  axis  relative  to 
the  INS  computed  platform  orientation  with  respect  to 
the  geographic  frame. 

The  fundamental  matrix  of  the  error  differential 
equations  of  the  filter  model  for  each  of  the  three  filters 
bears  some  correspondence  to  the  upper  left  16  x 16  parti- 
tion of  the  truth  model  fundamental  matrix.  The  basic 
9x9  partition  of  Table  2- 2a  is  also  used  in  the  three  fil- 
ters. The  added  elements  of  Table  2-2b  are  also  utilized, 
but  with  appropriate  changes  to  reflect  the  filter  state 
numbering  and  the  different  filter  altimeter  error  models. 
The  gyro  drift  state  coupling  into  attitude  error  in  the 
filter  is  the  same  as  the  3x3  lower  left  partition  in 
Table  2-2c.  The  cloc)c  error  model  in  the  filter  is  similar 
to  part  of  the  truth  error  model  of  Table  2-2e  as  will  be 
discussed  later. 

The  omitted  truth  states  which  drive  the  position, 
velocity  and  attitude  error  differential  equations  are 
compensated  for  in  the  filter  by  assuming  that  the  effects 
of  the  physical  error  sources  that  these  states  represent 
can  be  modeled  as  white  process  driving  noises.  The  com- 
pensation equations  presented  below  have  been  designed  based 
on  the  methodology  developed  by  Widnall  in  designing  the 
CIRIS  Kalman  filter  [4] . 

There  are  no  omitted  velocity  error  sources  driving 
the  position  error  dynamic  equations,  consequently,  no 
compensating  driving  noises  are  added  to  the  position  equa- 
tions. 

The  velocity  errors  are  driven  by  several  sources  of 
acceleration  error  that  are  not  included  in  the  filter 
state  vector.  These  acceleration  errors  are  modeled  as 


white  noises  driving  the  velocity  error  states.  The 
Kalman  filter  designer  must  assign  values  either  to  the 
elements  of  the  noise  vector  spectral  density  matrix  or 
to  the  elements  of  the  resulting  covariance  matrix  Q of 
the  velocity  error  added  during  each  filter  cycle. 

Specifying  the  noise  covariance  matrix  is  a most 
critical  step  in  obtaining  satisfactory  filter  perfor- 
mance. If  elements  in  the  assumed  noise  covariance 
matrix  are  too  small,  the  filter  will  become  overly  opti- 
mistic about  the  accuracy  of  the  extrapolated  state  esti- 
mate. This  results  in  the  underweighting  of  the  current 
measurement  data,  and  can  lead  to  divergence  of  the  esti- 
mated and  actual  state.  If  some  elements  in  the  assumed 
noise  covariance  matrix  are  too  large  relative  to  other 
elements,  this  causes  an  incorrect  distribution  of  the 
measurement  information  to  the  .aricus  sources  of  error 
being  estimated.  The  less-than-optimal  distribution 
allows  some  errors  to  be  badly  estimated.  For  example, 
excessively  large  assumed  noi >9  covariance  for  the  velo- 
city error  state  variables  can  prevent  satisfactory  esti- 
mation of  the  platform  misalignment. 

It  is  common  design  practice  to  determine  the  driving 
noise  covariance  matrix  by  experiment,  using  simulation 
or  real  flight  tests.  The  same  (constant)  matrix  is  used 
for  each  uniform  time  step.  The  driving-noise-covariance 
matrix  for  CIRIS  as  designed  by  Widnalll^)  is  a noticeable 
departure  from  this  standard  approach.  The  elements  of 
the  covariance  matrix  are  computed  as  explicit  functions 
of  the  assumed  subsystem  performance  parameters  and  of  the 
measured  vehicle  time-varying  maneuvers. 

The  CIRIS  methodology  has  been  applied  to  the  design 
of  the  driving  noise  covariance  matrix  for  the  IGI  Kalman 
filter.  In  the  case  of  the  velocity  error  states,  each 
filter  cycle,  the  following  east,  north,  and  up  variances 
are  added  to  the  respective  diagonal  elements  of  the  velo- 
city error  covariance  matrix; 

2v(Av^^  + Av„2)^  + (5  X 10"^  ft/sec )^(At/.2sec) 

lUaX  C ri 

Q = Q 

nn  '^ee  (3_1) 


where  v is  the  vehicle  speed,  Av^  and  Av^  are  the  integrated 
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east  and  north  specific  force  during  the  time  interval, 
and  At  is  the  time  interval  for  which  these  increases 
apply.  Omax  is  the  largei;t  one  sigma  value  from  among 
the  three  accelerometer  scale  factor  errors  and  the  six 
accelerometer  input  axis  misalignment  angles.  From  the 
Table  2-5  data,  the  largest  is  seen  to  be  8.73  x 10"^ 
radians  (180  arc  sec) . 

Note  in  this  simplified  driving  noise  matrix,  the 
east,  north,  and  up  variances  are  assumed  equal  and  the 
off-diagonal  covariances  are  assumed  zero.  A more 
accurate  (and  more  complex)  set  of  equations  for  the 
elements  of  the  3x3  noise  covariance  matrix  may  be 
found  in  the  CIRIS  design f . This  more  accurate  set 
is  an  explicit  function  of  the  individual  (different) 
one  sigma  values  of  the  accelerometer  scale  factor  errors 
and  input  axis  misalignments,  and  it  takes  into  account 
the  specific  orientation  (wander  angle)  of  the  X and  Y 
accelerometers  relative  to  the  east  and  north  axes. 

These  refinements  were  judged  not  necessary  for  this 
analysis. 

The  instrument-and-maneuver-dependent  term  in 
Eq. (3-1)  has  the  property  that  if  the  vehicle  is  under- 
going a 180®  turn,  the  application  of  Eq.(3-1)  each 
Kalman  time  interval  will  lead  to  a total  added  velocity 
error  covariance  in  the  filter  that  adequately  matches 
the  true  added  error  covariance.  The  desired  total  re- 
sult is  also  obtained  in  a prolonged  longitudinal  acceler- 
ation from  slow  speed  to  high  speed  (as  in  take-off) , or 
the  reverse. 

During  straight  and  level  flight,  when  the  horizon- 
tal components  of  specific  force  are  zero,  the  maneuver 
dependent  term  in  Eq. (3-1)  is  zero.  It  is  desirable 
to  have  some  minimum  value  of  driving  noise  to  model 
other  sources  of  error  such  as  shifts  in  the  accelerometer 
bias  and  shifts  in  the  gravity  deflection.  The  second 
term  in  Eq.(3-1)  serves  this  purpose.  The  numerical 
value  selected  is  the  same  as  that  in  the  initial  version 
of  the  IGI  simulator,  which  added  (5  x 10“^  ft/sec) ^ 
each  0.2  sec  time  update. 

The  attitude  errors  of  the  inertial  system  are  dri- 
ven by  several  sources  of  angular  velocity  error  that  are 
not  included  in  the  filter  state  vector.  The  most  signi- 
ficant of  these  are  normally  the  g-sensitive  gyro  drift 
rates.  Again  following  the  CIRIS  design  methodology,  an 
appropriate  covariance  matrix  for  the  effect  of  the 
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g-sensitive  gyro  drift  rates  in  a maneuver  has  been 
selected.  Each  filter  cycle  the  following  east,  north 
and  up  variances  are  added  to  the  respective  diagonal 
elements  of  the  attitude  error  covariance  matrix. 


7 2 2 

Q = 2v(Av^  + Av  ) ^ 

ee  ASD  e n 


Q = Q 
nn  ee 


(3-2) 


Q = Q 
zz  ee 


where  oasd  is  the  one-  sigma  value  of  the  uncompensated 
drift  coefficients,  which  is  the  same  for  all  six  coef- 
ficients of  the  three  IMU  axes.  Table  2-5  gives  the 
value  as  being  0.3°/hr/g. 

The  filter  model  for  the  clock  error  includes  only 
two  states  as  shown  in  Fig.  3-1  below: 


Fig.  3-1  Clock  Error  Model  of  the  Filter 


The  clock  phase  error  is  modeled  as  having  the  same 
driving  noise  statistic  used  to  drive  the  clock  phase  error 
state  (state  variable  10)  in  the  truth  model,  namely, 

N = 1.0  ft 2/sec. 
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The  clock  frequency  error  is  modeled  as  a first  order 
Markov  process  with  the  same  correlation  time  and  driving 
noise  statistic  as  that  used  in  the  truth  model;  i.e.. 


N = 2B*.  ,.2,  3 

tru  tru  ft  /sec  (3-3) 

tru  ' 


The  effects  of  error  states  13  and  51  in  the  truth  model 
are  small,  so  are  not  included  in  the  filter  model. 


The  gyro  drifts  are  modeled  as  random  walks  with  the 
same  driving  noise  statistics  as  those  used  in  the  truth 
model  for  the  gyro  drifts  (states  14,  15,  and  16): 

Npxj.  *=  (2.42  X 10  rads/sec)  ^/sec  = (.003/hr)  ^/hr. 

**DYF  ~ (2.42  X 10  rads/sec)  ^/sec  = (. 003/hr)  ^/hr . 


**DZF  ~ (4.03  X 10  rads/sec)  ^/sec  = (. 005/hr)  ^/hr. 


The  filter  vertical  acceleration  error  state  variable 
6a^  is  defined  to  be; 


6a^  = 6a  - 6a  (3-4) 

A 

where  6a  is  the  LN-15  computed  estimate  of  the  vertical 
acceleration  error  (state  11  of  the  truth  model)  and  7a 
is  the  slowly  varying  part  of  the  error  in  the  vertical 
acceleration  and  that  is  not  modeled  as  state  related. 

Some  various  sources  of  acceleration  error  6a  were  given 
in  Eq.(2-5).  The  terms  in  Eq. (2-5)  modeling  the  normal 
gravity  computation  error  and  the  acceleration  error  due 
to  platform  attitude  error  are  filter-state  related  (6h, 
ee»  and  are  modeled  properly  in  the  filter  fundamen- 

tal matrix.  The  acceleration  error  due  to  accelerometer 
input  axis  misalignment  is  not  slowly  varying  (the  hori- 
zontal specific  force  usually  varies  rapidly  compared  with 
the  vertical  channel  time  constant) . This  leaves  the  fol- 
lowing terms  as  included  in  7a: 
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(3-5) 


6a  = AB^  + gASF^  + 6g^ 

where  AB2  is  the  accelerometer  bias,  ASF^  is  the  accelero- 
meter scale  factor,  and  6g2  is  the  gravity  anomaly.  To 
obtain  the  elements  of  the  filter  fundamental  matrix 
associated  with  the  6az  row,  one  may  differentiate  the 
definition  (3-4) , using  Eg. (3-5) . It  can  be  shown  that 
the  derivative  is: 


6a  = k,(6h  - 6h,  ) - w,„  (3-6) 

z 3 b ABz 

The  first  term  (with  the  vertical  channel  gain  k3)  is 
related  to  the  filter  state  6h  and  the  filter  states  that 
are  chosen  to  model  the  altimeter  error.  The  second  term 
is  the  white  noise  associated  with  the  accelerometer  bias 
random  walk  model.  In  differentiating  the  terms  in 
Eq. (3-5)  we  have  assumed  gASF^  is  constant  and  we  have 
neglected  the  rate  of  change  of  the  gravity  anomaly.  The 
appropriate  expression  for  the  growth  Qaz  ir"  the  variance 
of  the  vertical  acceleration  state  due  to  the  white  .loise 
and  to  be  used  each  filter  time  update  is: 


Q 


az 


N 


ABZ 


At 


(3-7) 


The  filter  uses  a value  for  the  noise  spectral  density  of 
(10  yg)2/hr.,  which  is  the  same  as  is  assumed  in  the  truth 
model. 

3.2  Two-State  Altimeter  Error  Model 


Filter  A has  two  states  representing  the  altimeter 
sources  of  error:  One  state  a bias  error  and  the  other 
state  a scale  factor  error: 


+ e.  £ h 
po  hsf 


(3-8) 


where: 


e = Altimeter  bias  error  state 
po 
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r 


ejjg£  = Altimeter  scale  factor  error  state 
h = Aircraft  altitude 

As  in  the  truth  model,  the  altimeter  bias  error  is 
modeled  as  a first  order  Markov  process: 


®po 

~U)  1 ^ 6 + W 

alt  po  epo 

(3-9) 

“^alt  ^ 

'^/^alt 

(3-10) 

»*epo  = 

^‘"alt  °alt^ 

(3-11) 

where : 

dgj^^  = Correlation  distance  of  the  weather  patterns 
= Standard  deviation  of  altimeter  bias 
Ngpo  = Spectral  density  of  white  noise 

Numerical  values  for  dait  s^id  Oalt  the  same  as  those 

used  in  the  truth  model;  i.e., 

d^lt  = 250  n.m. 

°alt  “ 

The  altimeter  scale  factor  error  is  similarly  modeled  as  a 
first  order  Markov  process  but  with  a fixed  correlation 
time  of  two  hours: 


'hsf 


~®e  ®hsf  ^ '^e 
hsf  hsf 


where: 


hsf  ^200 (sec) 


\3-12) 
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The  spectral  density  of  the  white  noise  we^gf  related 
to  the  standard  deviation  of  the  sca-le  factor  errc^r  by: 

*^e  = o ^ (3-13) 

hsf  hsf  hsf 


The  Standard  deviation  Cshsf  used  in  equation  (3-13)  is 
the  same  as  that  used  in  the  truth  model;  i.e., 

o = 0.03 

hsf 


Note  that  even  thuugh  the  truth  model  treats  the 
scale  factor  error  as  a randor-  cons^^''t,  we  have  used  a 
first  order  Mar)cov  model  in  the  filter.  This  ensures  that 
the  filter  gains  associated  with  estimating  the  altimeter 
scale  factor  will  not  go  to  zero. 

3. 3 Bias  Single  State  Altimeter  Error  Model 

In  filter  B,  the  altimeter  error  6ht)  is  modeled  by  a 
single  bias-like  state 

6hb  = e^,^  (3-14) 


A random  walk  model  is  adopted  for  this  state: 


®bh 


(3-15) 


This  altimeter  model  is  the  same  as  that  used  in  the 
CIRIS  filterl^],  it  is  shown  that  a suitable  expression  for 
the  altitude  error  variance  growth  during  each  filter  cycle  is 

Qg  = 2(v/d3^^)  At  + aj  2h  |Ahl  (3-16) 

bh  hsf 


This  noise  variance  includes  a term  associated  with  the 
variation  in  the  bias  due  to  the  variation  in  the  height 
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of  a constant  pressure  surface  and  a term  which  models 
the  shift  in  the  bias  due  to  the  scale  factor  error  and 
a change  in  altitude.  It  can  be  shown  that  in  a climb 
from  near  sea-level  to  the  final  altitude  hf,  the  repeated 
application  of  Eq.(3-16)  each  filter  time  update  leads  to 
a total  added  altimeter  error  variance  from  the  second 
term  of  (Oe^gf  hf)2,  which  is  exactly  the  error  variance 
at  altitude  due  to  scale  factor  error. 

Not  included  in  Eg. (3-16)  is  an  additional  term 
from  the  CIRIS  design  which  can  model  the  shifts  in  alti- 
meter bias  due  to  speed  changes  and  the  static  pressure 
measurement  error.  At  subsonic  speeds,  modeling  this 
effect  in  the  filter  is  not  necessary. 

3 . 4 Scale  Factor  Single  State  Altimeter  Error  Model 

In  filter  C,  the  altimeter  error  (5hb  is  modeled  by 
a single  effective  scale  factor  error  state  ©seffs 


6h 


b 


h e 


sef  f 


(3-17) 


Assuming  the  two  most  significant  sources  of  error  are  the 
true  scale  factor  error  ej^sf  the  bias  &po  due  to  the 
zero-setting  error,  then  the  effective  scale  factor  error 
in  ter;ns  of  the  two  sources  is: 


e , + e /h 

seft  hsf  po 

A random  walk  model  is  adopted  for  this  state: 
®8eff  ~ '^eseff 


(3-18) 


(3-19) 


The  Kalman  filter  needs  an  expression  for  the  spectral 
density  Neseff  of  the  assumed  white  noise,  or  equivalently 
for  the  growth  Qeseff  if'  the  variance  of  the  estimate  of 
the  effective  scale  factor  error  in  a filter  time  step  At. 
Consider  the  differential  of  Eg. (3-18); 
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This  differential  suggests  that  the  changes  in  the 
effective  scale  factor  error  may  be  considered  to 
arise  in  three  ways:  from  changes  in  the  tru^  scal2 
factor  error,  from  changes  in  the  zero  setting  error, 
and  from  changes  in  altitude  in  the  presence  of  a 
non-zero  zero-setting  error.  The  mean  value  of  the 
differential  is  zero,  because  the  mean  of  each  term 
is  zero.  The  mean  square  value  of  the  differential 
is  the  sum  of  the  mean  square  values  of  each  term,  oe- 
cause  each  term  is  statistically  independent.  This 
suggests  an  expression  for  the  growth  Qeseff  ^he 
variance  of  the  estimate  of  the  effective  scale  factor 
error  be  made  up  of  the  sum  of  three  terms: 

“eseft  " »ohsf  * Oepo  ^ + »alt'  I»(l/h))'  (3-21) 

The  first  term  can  utilize  the  noiue  spectral  density 
from  Eq. (3-13),  which  accounts  for  the  random  walk  nature 
of  the  true  scale  factor  error: 


ehsf 


= 2B  . c cr  . , At 

ehsf  ehsf 


(3-22) 


The  second  term  can  utilize  the  noise  spectral  density 
from  Eqs.  (3-11)  and  (3-10) , which  accounts  for  the  random 
walk  nature  of  the  zero-setting  error: 


epo 


= 2(v/d^^^) 


At 


(3-23) 


The  third  term  requires  some  discussion.  In  line  with  the 
CIRIS  design  methodology,  we  seek  an  alternate  expression 
for  the  third  term  which  is  a function  of  uhe  current 
altitude  h and  the  change  Ah  in  altitude  during  the 
current  filter  time  step.  It  can  be  shown  that  an  upper 
bound  on  the  square  of  the  change  in  inverse  altitude  is; 

[A(l/h)]^  = (l/n^  - l/h^)^  < 1/h^^  - 1/h^^ 


for  0 < hj^  < h2 


(3-24) 
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Note  this  bound  is  a definite  integral: 


/ 2(l/h-")  dh  = 1/h,  - 1/h, 


for  0 < 


(3-25) 


This  suggests  an  appropriate  alternate  expression  for 
the  third  term  as  being: 


(3-26) 


Repeated  application  of  this  expression,  each  Kalman 
time  update,  leads  to  a total  added  variance  which  is 
an  upper  bound  on  the  added  variance  due  to  the  complete 
climb  or  descent. 

Using  Egs.(3-22),  (3-23),  and  (3-26),  the  expression 
used  in  filter  C for  the  growth  in  the  variance  of  the 
effective  scale  factor  error  estimate  is: 


°eseff  = At  + 2(v/d_,,)  At/h' 


‘^ehsf  ehsf 
+ 2(l/h^)  I Ah  I 


alt'  “alt 


(3-27) 


Note  the  fundamental  difference  between  the  above 
effective  scale  factor  error  model  and  the  scale  factor 
error  model  evaluated  by  Myers  and  Butler The  above 
model  is  a random  walk  model,  whereas  the  Myers/Butler 
filter  model  used  a random  constant  model.  The  random 
walk  model  ensures  that  the  Kalman  gain  associated  with 
estimating  the  effective  scale  factor  error  will  not  go 
to  zero. 

3.5  Measurements  Error  Model 


The  truth  model  for  the  errors  in  the  GPS  measurements 
were  discussed  in  Section  2.3.  The  Kalman  filter  processes 
a pseudo  range  difference  measurement  and  a pseudo  range- 
rate  difference  measurement.  These  measurements  are  the 
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differences  between  the  receiver-measured  quantities 
(pseudo  range  and  pseudo  range-rate)  and  the  computed 
quantities  based  on  the  INS  indicated  position  and  velo- 
city and  on  the  satellite  ephemeris. 

The  Kalman  filter  employs  linearized  models  for 
these  difference  measurements: 


(3-28) 


(3-29) 


where  hpr  and  are  the  measurement  gradient  vectors, 

X is  the  filter  state  vector  and  vpr  and  vpV  are  additive 
random  error.  Non-zero  elements  in  the  pseudo  range  dif- 
ference gradient  vector  are  associated  with  the  position 
error  states  and  the  clock  phase  error  state.  Non-zero 
elements  in  the  pseudo- range-rate  difference  gradient 
vector  are  associated  with  the  velocity  error  states  and 
with  the  clock  frequency  error  state. 

Values  assumed  in  the  filter  for  the  variances  of  the 
additive  random  errors  are  the  same  as  for  the  actual 
errors  in  the  truth  model,  namely: 


Op^  = 20  feet 
o . = 0.45  ft/sec 
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SECTION  IV 

INTEGRATED  GPS/INERTIAL  PERFORMANCE 


The  IGI  Simulator  has  been  used  to  evaluate  the 
three  alternate  Kalman  filter  vertical  channel  designs, 
which  were  developed  in  the  previous  section.  Each 
filter  was  exercised  using  the  same  truth  model  for 
the  sources  of  error  and  using  the  same  F4  aircraft 
trajectory.  The  truth  model  and  trajectory  were  pre- 
sented in  Section  2.  This  section  presents  and  dis- 
cusses the  simulation  results. 

The  results  are  presented  in  terms  of  plots,  which 
contain  both  the  estimation  error  and  the  filter-computed 
uncertainty.  The  estimation  error  is  the  difference 
between  the  Kalman  filter  best  estimate  of  a variable 
and  the  true  value  of  a variable  as  known  from  the  truth 
model.  The  filter-computed  uncertainty  or  one-sigma 
value  is  the  square  root  of  the  appropriate  diagonal  ele- 
ment of  the  filter  estimation  error  covariance  matrix. 

This  one-sigma  value  has  been  plotted  both  plus  and  minus 
to  establish  a visual  band  for  evaluating  the  filter  per- 
formance. For  both  the  errors  and  the  uncertainties, 
plot  points  include  the  values  both  before  and  after  in- 
corporating each  set  of  eight  pseudo  range  and  pseudo 
range-rate  measurements. 

In  the  presentations  which  follow.  Case  A uses  the 
filter  with  the  two-state  altimeter  error  model.  Case  B 
uses  the  filter  with  the  random  walk  bias  single-state 
altimeter  error  model,  and  Case  C uses  the  filter  with 
the  random  walk  effective  scale  factor  single-state 
altimeter  error  model. 

A comparison  of  the  horizontal  position  and  velocity 
errors  is  presented  first  in  Subsection  4.1,  followed  by 
a comparison  of  the  vertical  channel  errors  in  Subsection 
4.2.  The  attitude  errors  are  discussed  in  Subsection  4.3. 
The  clock  phase  and  frequency  errors  are  discussed  in 
Subsection  4.4. 
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4.1  Horizontal  Position  and  Ve locity  Frror s 

The  horizontal  position  and  velocity  errors  of  the 
three  cases  are  compared  in  Figures  4-1  through  4-4. 

There  is  little  difference  between  the  three  cases.  A 
reasonable  conclusion  is  that  the  differences  in  the  three 
vertical  channel  designs  produce  only  second  order  effects, 
in  the  horizontal  position  and  velocity. 

During  the  initial  flight  segment  with  full  GPS 
availability,  the  filter-computed  east  and  north  position 
uncertainties  are  about  ten  to  twelve  feet.  During  the 
simulated  jamming  period  between  685  sec  and  1110  sec, 
during  which  no  GPS  measurements  were  available,  the  esti- 
mation errors  and  the  computed  uncertainties  grow  signifi- 
cantly. A "flat  top"  corresponds  to  an  off-scale  value  of 
a variable.  The  east  position  error  in  Figure  4-1  is 
generally  within  the  filter- ■'omputecl  urrertcinty. 


The  north  position  error  shown  in  Figure  4-2  has  a 
bias  of  about  twenty  feet.  U'e  believe  this  bias  is  a 
result  of  the  choice  of  the  reference  position  about  which 
the  Kalman  filter  measurement  processing  equations  are 
linearized.  In  both  the  original  version  of  the  IGI 
Simulator  113  and  in  the  present  version  used  in  this  study, 
the  Kalman  filter  processes  a pseudo  range  difference 
measurement  z that  is  the  difference  between  the  receiver- 
measured  pseudo  range  and  the  computed  pseudo  range  based 
on  the  INS  indicated  position.  The  filter  forms  its  own 
a priori  best  estimate  2 of  the  measurement  using  a linear- 
ized model  for  the  relationship  between  the  best  estimate 
of  the  state  x and  the  measurement: 


A 

Z 


h^  X- 


(4-1) 


The  filter  then  uses  the  residual  difference  between  the 
measurement  and  the  expected  measurement  to  update  the 
state  vector; 


x^  = X + k(z  - z)  (4-2) 

In  the  present  study,  the  simulated  INS  east  and  north 
position  errors  are  both  of  the  order  of  7,000  feet,  as 
was  shown  in  Figure  2-6.  The  filter  rapidly  converges  to 
estimages  of  the  position  errors  that  are  close  to  the 
true  errors.  Hence  the  INS  latitude  and  longitude  error 
elements  in  the  filter  state  vector  are  angles  representing 
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the  order  of  7,000  feet.  The  measurement  gradient  vector 
h was  derived  using  a spherical  earth  assumption.  As  a 
result,  the  elements  of  h,  which  give  the  rate  of  change 
of  the  difference  measurement  with  respect  to  longitude 
error  and  latitude  error,  are  functions  of  a value  of 
earth  radius  that  is  not  precisely  equal  to  the  local 
earth  radius  of  curvature.  The  value  is  wrong  by  about 
0.3%  compared  with  the  correct  curvature  for  the  latitude 
element.  This  0.3%  error  in  the  latitude  error  element 
of  h when  multiplying  a latitude  error  state  estimate  of 
7,000  feet  leads  to  an  error  in  the  best  estimate  of  the 
pseudo  range  difference  of  about  twenty  feet  (for  satel- 
lites in  a northerly  or  southerly  direction) . The  Kalman 
filter  must  converge  to  an  estimate  of  the  state  that 
leaves  no  bias  in  the  residual.  It  does  this  by  having 
a 0.3%  error  (twenty  feet)  in  its  best  estimate  of  INS 
latitude  error  to  offset  the  0.3%  error  in  h.  The  value 
for  earth  curvature  used  for  the  longitude  error  state 
happens  to  be  more  nearly  correct,  so  a similar  large  bias 
in  east  position  error  is  not  produced. 

This  biasing  effect  can  be  eliminated  either  by  using 
more  accurate  expressions  for  the  elements  of  the  h vector 
or  by  changing  the  reference  position  about  which  the  mea- 
surement processing  equations  are  linearized.  One  form 
of  the  second  approach  is  to  utilize  a pseudo  range  dif- 
ference measurement  that  is  the  difference  between  the 
receiver-measured  pseudo  range  and  the  computed  pseudo 
range  based  on  the  filter  best  estimate  of  position.  An 
equation  li)ce  Eq.  (4-1)  is  then  not  needed  (except  perhaps 
for  the  cloc)c  phase  error)  because  the  best  estimate  of 
the  difference  measurement  is  zero. 

The  horizontal  velocity  errors  are  shown  in  Figures 
4-3  and  4-4.  The  east  and 'north  results  are  similar. 

During  the  first  300  sec  (before  any  turns) , the  velocity 
errors  are  about  0.2  ft/sec.  At  about  300  sec  the  rapid 
maneuvering  begins.  The  filter-computed  uncertainties 
increase  due  to  the  maneuver-dependent  noise  covariance. 

East  velocity  error  peaks  larger  than  one  ft/sec  are  seen. 
The  error  fluctuations  are  similar  in  amplitude  to  the  INS 
(no  GPS)  east  velocity  error  shown  in  Figure  2-7.  During 
the  period  of  jamming,  the  velocity  errors  stay  under  one 
ft/sec.  The  INS  velocity  errors  in  this  period  are  shifting 
more  than  two  ft/sec.  The  filter  computed  uncertainty  in 
this  period  is  somewhat  conservative. 
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Figuro  4-3  GPS/lnf*rtial  East  Velocity  Errors 


Figure  4-4  GPS/Inertial  North  Velocity  Errors 
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4.2  Vertical  Channel  Errors 


Figure  4-5  shows  a plot  of  altitude  error  for  Case  A 
on  the  same  scale  as  the  position  error  plots  of  Figures 
4-1  and  4-2,  while  Figure  4-6  compares  the  altitude  errors 
for  the  three  filter  cases.  A comparison  of  the  altitude 
error  of  Figure  4-5  with  the  position  error  plots  of 
Figures  4-1  and  4-2  shows  a general  characteristic  of  GPS 
navigators:  The  altitude  error  tends  to  be  about  twice 

as  large  as  the  horizontal  position  errors.  This  can  be 
explained  by  analyzing  the  geometric  dilution  of  prt;cision. 
Figure  4-6  shows  that  except  for  the  period  of  GPS  signal 
loss,  there  is  little  to  distinguish  between  the  altitude 
errors  of  the  three  filter  mechanizations.  During  the 
period  of  GPS  signal  loss,  the  altitude  error  in  Case  A 
reaches  a peak  value  of  about  400  feet.  This  compares 
with  altitude  errors  ranging  from  -340  to  680  feet  in 
Case  B and  ranging  from  770  feet  to  -885  feet  in  Case  C/ 

The  vertical  velocity  errors  are  shown  in  Figure  4-7. 
Before  loss  of  GPS  signals,  the  three  cases  give  almost 
identical  results.  During  the  period  of  loss  of  signal. 
Case  A has  errors  as  large  as  two  ft/sec.  Case  B as  large 
as  three  ft/sec,  and  Case  C larger  than  four  ft/ sec  (off 
scale) . The  baro-inertial  (no  filter)  vertical  velocity 
error  shown  in  Figure  2-8  has  peak  errors  of  three  and  four 
ft/sec.  Design  A shows  a clear  improvement  and  design  B 
shows  some  improvement  relative  to  the  no-filter  baro- 
inertial  vertical  velocity.  Design  C may  be  worse  than 
the  no-filter  baro-inertial  vertical  velocity  during  the 
loss  of  signal. 

How  well  are  the  altimeter  error  states  working?  The 
errors  in  the  two  altimeter  states  of  Case  A are  shown  in 
Figure  4-8.  The  scale  factor  error  in  the  truth  model 
is  0.03.  The  estimation  error  of  the  filter  is  generally 
less  than  0.01,  which  indicates  good  filter  performance. 

The  computed  uncertainty  is  somewhat  conservative  being  at 
0.02.  A good  scale  factor  error  estimate  is  held  through 
the  dive  and  climb  during  the  period  of  jamming.  When  GPS 
signals  return,  the  aircraft  is  at  its  highest  altitude. 
This  loads  to  a noticeable  reduction  in  the  scale  factor 
error  uncertainty.  At  higher  altitudes,  the  scale  factor 
is  more  observable.  The  altimeter  bias  estimation  error 
is  also  shown  in  Figure  4-8.  The  vehicle  descends  to 
10,000  feet  at  400  sec.  At  this  low  altitude  the  scale 
factor  effect  is  less  and  the  bias  becomes  more  observable. 
The  bias  uncertainty  is  reduced  to  about  200  feet. 
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Figure  4-5  GPS/lnertial  Altitude  Errors  for  Case  A (Expanded  Scale) 
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Figure  4-8  Filter  A Altimeter  Bias  and  Scale  Factor  Errors 
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The  first-order  Markov  altimeter  bias  simulation  in 
the  truth  model  has  a particularly  large  bias  excursion 
during  the  period  of  jaunming.  Supposedly  having  a one- 
sigma  value  of  500  feet,  the  bias  actually  exceeds 
1,000  feet.  Table  4-1  compares  the  true  altimeter  bias 
with  the  filter  estimate  at  several  points  during  the 
period  of  no  GPS  signals. 


Table  4-1 

Altimeter  Bias  True  Values 
and  Filter  Estimates  - Case  A 


TIME  (SECS) 

TRUE 

VALUE  (FT) 

FILTER 

ESTIMATE  (FT) 

ERROR  (FT) 

700 

785 

795 

-10 

800 

914 

752 

162 

900 

1084 

711 

370 

1000 

1067 

673 

393 

1100 

989 

636 

353 



The  growth  in  estimation  error  to  390  feet  is  due  largely 
to  the  300  foot  shift  in  the  true  altimeter  bias  in 
300  sec.  Such  a rapid  shift  is  not  realistic  for  normal 
weather  conditions. 

The  Case  B filter  uses  a random  walk  bias  state  alti- 
meter error  model.  The  estimation  error  of  this  state  and 
its  filter-computed  uncertainty  are  plotted  in  Figure  4-9. 
The  estimation  error  that  is  plotted  is  defined  to  be; 


6e 


bh 


®po  ®hsf  ^ ■ 


'bh 


(4-3) 


where  epo  is  the  truth  model  altimeter  bias,  ehsf  is  the 
truth  model  altimeter  scale  factor  error,  and  ebh  is  the 
filter  altimeter  error  estimate.  A better  definition  of 
the  estimation  error  would  have  included  as  well  a third 
term  and  fourth  term  from  the  truth  model  which  are  the 
altimeter  error  contributions  of  the  static  pressure  mea- 
surement error  and  the  altimeter  lag.  The  static  pressure 
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measurement  error  contributes  about  100  feet  of  error 
to  the  altimeter  error  at  the  speeds  of  this  trajectory. 
Omitting  this  effect  from  the  estimation  error  definition 
of  Eq. (4-3)  leaves  a bias  of  about  100  feet  in  the  esti- 
mation error  plot  of  Figure  4-9. 

During  the  period  of  GPS  signal  loss,  the  filter 
holds  its  estimate  ej^^  of  altimeter  error  at  a constant 
value  of  1,466  feet.  The  variations  in  the  estimation 
error  are  due  entirely  to  variations  in  the  first  two 
terms  of  Eq. (4-3) . The  effects  of  the  reduction  in  the 
scale  factor  error  term  during  the  dive  at  about  750  sec 
and  the  growth  in  that  term  during  the  subsequent  climb 
are  clearly  seen  in  the  estimation  error.  Note  the  fil- 
ter-computed uncertainty  for  the  altimeter  error  estimate 
increases  during  the  dive  in  good  agreement  with  the 
growth  in  estimation  error.  The  maneuver  dependent  filter 
driving  noise,  which  was  given  in  Eq.(3-16),  is  working 
as  intended.  In  the  subsequent  climb,  the  filter-computed 
uncertainty  increases  further  and  becomes  conservatively 
large.  The  single  error  state  model  is  not  able  to  predict 
the  reduction  in  the  estimation  error  as  the  aircraft 
climbs  back  to  the  altitude  of  the  beginning  of  the  period 
of  signal  loss. 

The  Case  C filter  uses  a random  walk  scale  factor 
single  state  altimeter  error  model.  The  estimation  error 
of  this  state  and  its  filter  computed  uncertainty  are  plot- 
ted in  Figure  4-10.  The  estimation  error  that  is  plotted 
is  defined  to  be: 
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(4-4) 


where  epQ  and  ehsf  from  the  truth  model  as  before,  and 

®seff  is  the  filter  effective  scale  factor  error  estimate. 
The  filter  state  tracks  well  during  the  periods  of  conti- 
nuous GPS  coverage.  During  the  loss  of  GPS  signals,  the 
state  holds  constant  at  an  estimated  effective  scale  factor 
error  of  0.079.  The  scale  factor  error  Chsf  in  the  truth 
model  is  constant  at  0.030,  so  variations  in  the  plotted 
estimation  error  are  due  to  v’ariations  in  epo  on  h,  which 
comprise  the  first  term  of  Eq.  (4-4).  The  dive  at  about 
750  sec  drives  the  first  term  off  scale.  The  filter-com- 
puted uncertainty  increases  significantly  during  the  dive 
in  accordance  with  the  maneuver  dependent  driving  noise. 
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which  was  given  in  Eq. (3-27) . During  the  subsequent 
climb  to  highest  altitude,  the  contribution  of  the  first 
term  decreases  and  the  estimation  error  '"eturns  to  on 
scale,  passes  through  zero,  and  becomes  somow’iat  nega- 
tive. The  computed  uncertainty  is  very  large  after  the 
dive  and  climb  with  no  GPS  measurements.  The  single 
error  state  model  is  not  able  to  predict  the  reduction 
in  the  estimation  error  as  the  aircraft  climbs  back  to 
the  altitude  of  the  beginning  of  the  period  of  signal 
loss . 

4 . 3 Attitude  and  Gyro  Drift  Errors 

Figures  4-11,  4-12,  and  4-13  compare  the  east,  north, 
and  azimuth  attitude  errors  of  the  three  cases.  There  are 
no  noticeable  differences  between  the  three  cases.  A 
reasonable  conclusion  is  that  the  differences  in  the  three 
vertical  channel  designs  produce  only  second  order  effects 
in  the  attitude  errors. 

Both  the  east  and  north  components  of  attitude  error 
are  seen  to  have  biases  which  lie  outside  the  filter 
computed  one-sigma  uncertainty.  Here  this  is  not  an  indi- 
cation of  poor  filter  performance.  The  attitude  estimation 
error  plotted  is  the  difference  between  the  attitude  error 
in  the  truth  model  and  the  attitude  error  estimate  in  the 
filter.  The  horizontal  components  of  attitude  error  Cg  and 
Sri  in  the  truth  model  are  not  the  only  sources  of  horizon- 
tal acceleration  error.  Inspection  of  Table  2-2  giving 
the  truth  model  fundamental  matrix  shows  that  the  east  and 
north  velocity  error  differential  equations  are  also 
forced  by  acceleration  errors  due  to  the  accelerometer 
biases  AB^  and  ABy,  the  accelerometer  input  axis  misalign- 
ments XAy  and  YAx,  and  deflections  of  gravity  and  6gn. 
These  additional  truth  states  are  not  modeled  in  the  Kalman 
filter.  Their  effect  is  absorbed  in  the  filter  estimates 
of  the  attitude  error.  As  a result,  one  expects  to  see 
biases  in  the  attitude  estimation  errors  of: 


e bias 

-ABy/g  - YA^  - <Sg^/g 

(4-5) 

n bias 

AB^/g  - XA^  + 6g^/g 

(4-6) 

The  above  equations  are  derived  assuming  zero  wander  angle 
(X  axis  east  and  Y axis  north) , which  is  approximately  the 
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case  in  this  simulation.  Substituting  the  initial 
numerical  values  for  these  sources  of  error  gives 
expected  approximate  values  for  the  attitude  estima- 
tion error  biases  of; 


^e  bias 


-44  arc  sec 


^n  bias 


+46  arc  sec 


These  values  agree  approximately  with  the  biases  in 
the  plots. 

The  filter-computed  uncertainties  of  the  east 
and  north  attitude  estimation  error  show  the  initial 
transient  and  the  effect  of  the  maneuver  dependent 
driving  noise.  During  the  initial  period  of  non- 
maneuvering flight,  the  filter-computed  uncertainty  is 
reduced  to  less  than  ten  arc  sec.  When  the  rapid  maneu- 
vering begins,  the  filter-computed  uncertainty  rises  to 
a higher  level. 

The  azimuth  estimation  error  is  shown  in  Figure  4^-13 
During  the  initial  period  of  non-maneuvering  flight,  the 
azimuth  error  is  growing  and  the  filter-computed  uncer- 
tainty shows  little  improvement.  The  subsequent  maneu- 
vering provides  more  direct  observability  of  the  azimuth 
error.  The  estimation  error  and  the  computed  uncertainty 
both  are  reduced. 

We  have  inspected  the  print-out  associated  with  the 
gyro  drift  rate  estimates.  The  results  show  no  reduction 
in  filter-computed  uncertainties  of  the  gyro  drift  rates 
and  the  filter  estimates  of  the  gyro  drift  rates  remain 
near  the  initial  zero  values.  These  states  therefore 
were  of  little  benefit  to  the  navigation  performance  in 
this  flight.  It  is  possible  that  on  a longer  flight  and 
with  less  maneuvering,  the  filter  could  obtain  a useful 
estimate  of  the  effective  north  gyro  drift  rate  and  per- 
haps the  azimuth  gyro  drift  rate.  In  any  case,  the  effec 
tive  east  gyro  drift  rate  is  probably  unobservable. 
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Figure  4-11  GPS/lnertial  East  Attitude  Errors 
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4.4 


Clock  Phase  and  Frequency  Errors 


Figure  4-14  and  4-15  compare  the  clock  phase  and 
frequency  estimation  errors  of  the  three  cases.  There 
are  no  noticeable  differences  between  the  three  cases. 

The  filter-computed  uncertainties  for  both  clock 
phase  and  frequency  are  in  good  agreement  with  the  level 
of  the  estimation  errors,  both  during  the  periods  of 
GPS  measurements  and  during  the  jamming  period. 

Figure  4-16  replots  the  clock  phase  error  for 
Case  C on  an  expanded  scale.  It  is  interesting  to  note 
that  the  clock  phase  estimation  error  is  similar  (but  with 
a sign  reversal)  to  the  altitude  estimation  error  shown 
in  Figure  4-5.  This  is  often  observed  in  GPS  navigation 
solutions.  Because  the  four  satellites  being  used  are 
necessarily  above  the  horizon,  the  measurement  directions 
are  all  in  the  upper  hemisphere,  which  leads  to  strong 
correlation  between  altitude  error  and  clock  phase  error. 
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SECTION  V 

SUMMARY  AND  CONCLUSIONS 


The  Integrated  GPS/Inertial  (IGI) Simulator  has 
been  utilized  to  explore  several  design  issues 
associated  with  the  vertical  channel  of  a GPS/baro/ 
inertial  navigation  system.  The  primary  issues 
explored  were  associated  with  the  modeling  of 
barometric  altimeter  error  in  the  Kalman  filter. 

Should  two-state  variables  be  used  in  the  filter  to 
model  altimeter  error,  or  is  one  sufficient?  If  only 
one  state  is  used,  should  it  be  a bias-like  error 
model  or  should  it  be  a scale-factor  error  model? 

How  can  an  assumed  white  noise  driving  a single  error 
state  be  used  to  model  the  effect  of  other  sources 
of  error? 

The  assumed  navigation  system  is  comprised  of: 
a local-level  wander  azimuth  inertial  navigation 
system  with  associated  barometric  altimeter  for 
stabilizing  the  vertical  channel,  a GPS  pseudo  range 
and  range-rate  receiver,  and  a navigation  computer 
hosting  a Kalman  filter  to  integrate  the  baro/inertial 
and  GPS  data. 

The  error  model  in  the  simulator  has  fifty-four 
states  representing  the  inertial  navigation  position, 
velocity,  and  attitude  errors,  the  gyro  sources  of 
error,  the  accelerometer  sources  of  error,  the  gravity 
deflections  and  anomaly,  the  barometric  altimeter 
sources  of  error,  and  the  GPS  receiver  clock  phase  and 
frequency  errors.  Significant  sources  of  barometric 
altimeter  error  included  are  the  zero-setting  error, 
the  scale  factor  error,  the  static  pressure  measure- 
ment error,  and  the  altimeter  lag. 

The  simulated  flight  path  is  representative  of 
a F-4  aircraft  tactical  mission  profile.  There  are 
periods  of  straight  and  level  flight,  dives  and  climbs, 
and  high-g  evasive  maneuvering.  There  is  a seven 
minute  period  during  which  jamming  prevents  the  use 
of  GPS  measurements.  During  this  period,  the  aircraft 
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dives  15,000  feet  to  a hypothetical  target  area,  then 
climbs  back  to  altitude. 

Three  Kalman  filter  vertical  channel  designs  were 
evaluated.  Filter  A has  seventeen  states  and  filters 
B and  C have  sixteen  states.  The  first  fifteen  states 
are  common  to  all  three  filters.  These  are  the  states 
modeling  INS  position,  velocity,  and  attitude  errors 
(9);  receiver  clock  phase  and  frequency  errors  (2'; 
gyro  drift  rates  (3) ; and  vertical  acceleration  error 
(1) . The  modeling  of  these  fifteen  states  is  similar 
to  that  in  the  Kalman  filter  in  the  original  IGI  simu- 
lator, except  that  maneuver-dependent  variances  of  the 
driving  noises  have  been  introduced  to  model  the  effects 
of  accelerometer  scale  factor  errors  and  input  axis 
misalignments  and  to  model  the  effects  of  gyro  g-sensi- 
tive  drift  rates. 

Filter  A has  two  states  representing  the  altimeter 
sources  of  error:  one  state  a bias  error  and  the  other 
state  a scale  factor  error.  Filter  B has  only  one 
altimeter  error  state,  and  it  is  a random  walk  bias 
model.  Filter  C also  has  only  one  altimeter  error 
state,  but  it  is  a random  walk  scale  factor  error 
model.  The  single-state  error  models  have  variances 
for  their  driving  noises  that  are  functions  of  the 
altitude  changes. 

Analysis  of  the  alternate  designs,  including  the 
comparative  simulation  results  has  led  to  several 
observations  and  conclusions.  The  three  filter  designs 
provide  essentially  identical  navigation  performance 
when  GPS  measurements  are  available.  The  differences 
in  performance  arise  during  loss  of  signal. 

Filter  A with  its  two-state  altimeter  error  model 
provides  the  best  vertical  channel  performance  during 
loss  of  signal.  After  processing  external  (GPS)  mea- 
surements during  descents  and  climbs,  the  filter  is  able 
to  calibrate  both  the  zero-setting  error  and  the  scale 
factor  error.  This  leads  to  improved  vertical  channel 
performance  during  the  subsequent  dive  and  climb  in  the 
period  of  no  external  measurements  (jamming) . In  the 
jamming  period,  peak  altitude  error  was  400  feet  and 
the  largest  vertical  velocity  error  was  about  two  feet 
per  second. 


Filter  B with  its  single-state  altimeter  bias  model 


-72- 


converges  to  a correct  estimate  of  the  combined  alti- 
meter error  while  processing  external  measurements. 
During  the  jamming  period,  the  bias  estimate  holds 
constant.  In  the  dives  and  climbs  during  the 
jamming  period,  the  true  altimeter  scale  factor  error 
causes  shifts  in  the  altimeter  error,  which  cannot  be 
compensated  by  filter  B.  The  simulation  results 
exhibited  altitude  errors  from  -340  to  680  feet  and 
a peak  vertical  velocity  error  of  about  3 feet/sec. 

Filter  C with  its  single-state  altimeter  scale 
factor  model  has  the  worst  vertical  channel  perfor- 
mance. The  estimate  of  the  effective  scale  factor 
error  converges  to  a correcr  value  while  processing 
external  measurements.  This  effective  scale  factor 
error  estimate  when  multiplied  by  the  current  altitude 
gives  a value  for  baro  altitude  error  that  matches 
the  total  baro  altitude  error  from  the  several  sources 
of  error.  During  the  jamming  period,  the  effective 
scale  factor  error  estimate  holds  constant.  The 
accuracy  of  the  baro  altitude  error  estimate,  during 
dives  and  climbs  in  this  jeimming  period,  depends  on 
the  difference  between  the  estimated  effective  scale 
factor  error  and  the  true  scale  factor  error.  In  the 
simulation  case,  the  estimated  scale  factor  error  was 
0.08  and  the  true  scale  factor  error  was  0.03.  The 
difference  of  0.05  provided  a strong  excitation  to 
the  errors  in  the  filter  estimates  of  vertical 
velocity  and  altitude.  Altitude  errors  ranged  from 
770  feet  to  -885  feet  and  the  peak  vertical  velocity 
error  was  larger  than  4 feet/sec.  The  vertical  velo- 
city estimation  errors  of  the  filter  were  actually 
larger  than  the  vertical  velocity  errors  of  the  no- 
filter baro-inertial  system.  If  the  period  of  jamming 
had  started  at  a higher  altitude  or  had  the  zero  set- 
ting error  been  smaller,  then  the  difference  between 
the  effective  scale  factor  error  and  the  true  scale 
factor  error  would  have  been  smaller  and  the  subse- 
quent vertical  channel  errors  during  the  dives  and 
climbs  would  have  been  smaller. 

A filter  similar  to  filter  C was  evaluated  by 
Myers  and  Butler.  It  also  had  a single-state  alti- 
meter error  model,  which  was  a scale  factor  error. 
However,  this  state  was  modeled  as  a random  constant 
rather  than  a random  walk.  In  the  simulation  results, 
while  processing  GPS  measurements  (no  jamming)  the 
filter  diverged  from  correct  estimates  of  vertical 
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velocity,  altitude,  and  even  latitude  and  longitude. 
While  we  have  not  attempted  to  re-run  this  exact 
design,  we  believe  the  design  diverged  because  of 
the  random  constant  model.  Kith  such  a model,  the 
filter  will  converge  to  a fixed  estimate  of  the 
effective  scale  factor  error  and  the  computed  un- 
certainty will  go  to  zero.  With  complete  confidence 
in  its  calibrated  baro  altimeter  data,  and  because 
of  the  closed  baro-inertial  loop,  the  filter  computed 
uncertainty  in  the  estimate  of  altitude  also  goes 
to  zero.  The  filter  then  ignores  current  external 
(GPS)  measurements  as  far  as  altitude  updating  is 
concerned.  If  there  is  actually  a large  altitude 
estimation  error,  the  GPS  measurement  residuals 
must  be  put  somewhere,  and  this  leads  to  forced 
errors  in  the  estimates  of  latitude,  longitude, 
and  clock  phase.  The  fil'-er  C evaluated  in  this 
report  avoids  these  per^orm"’nce  difficulties  by 
using  a random  walk  error  model.  The  variance 
assigned  to  the  driving  noise  is  sufficient  to  pre- 
vent the  filter  from  becoming  over  confident. 

The  other  estimation  errors  of  the  three  Kalman 
filter  designs  were  also  analyzed.  The  horizontal 
position  and  velocity  errors,  the  attitude  errors, 
and  the  clock  phase  and  frequency  errors  for  the 
three  cases  were  essentially  identical  including 
during  the  period  of  jamming.  The  differences  in 
the  vertical  channel  designs  produced  no  significant 
differences  in  these  other  errors. 

The  three  filters  exhibited  good  self  consis- 
tency. The  filter  computed  uncertainties  were  general- 
ly in  agreement  with  the  estimation  errors.  An  excep- 
tion was  the  north  position  error,  which  had  a bias 
value  exceeding  the  computed  uncertainty.  Changes 
to  the  measurement  processing  are  proposed  which 
should  eliminate  the  bias.  The  horizontal  components 
of  attitude  error  also  have  values  exceeding  the  com- 
puted uncertainties.  These  biases  are  the  unobservable 
tips  due  to  various  sources  of  horizontal  acceleration 
measurement  error.  The  maneuver  dependent  driving 
noises  for  the  velocity  error  states,  the  attitude  error 
states,  and  the  baro  altitude  error  state  help  provide 
the  desired  consistent  performance. 
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